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VERIFICATION OF THE KAIMAN FILTER EQUATIONS 
USED IN THE IM AGS 

By Richard E. Eckelkamp and Troy J. Blucker, MFB, 
and Samuel Pines, AMA, Inc. 


SUMMARY 


The coasting-flight navigation equations used for processing 
rendezvous radar measurements in the lunar module abort guidance 
system (AGS) computer (AGC) are shown to be soundly based upon Kalman 
filter theory. Explanation and implications are given for the assump- 
tions of linearity and perfect range-rate data and for the time- 
delayed incorporation of measurements. 


INTRODUCTION 


Reference to the AGS rendezvous radar navigation program as a 
"simplied Kalman filter" has left many uneasy as to its theoretical 
validity and numerical accuracy. An exposition of the theoretical and 
analytical consequences of the simplifications, originally made to save 
storage space in the AGC, has been needed. This report examines the 
theoretical consequences, The analytical or numeric consequences are 
being explored by the Mathematical Physics Branch and TRW (Los Angeles). 

Closer observance of the filter equations leads to their simple 
derivation from basic Kalman theory, the theory on which the primary navi- 
gation systems in both the CM and LM are built. This paper derives the 
Kalman equations from theory and from the assumptions made in the AGS. 

The results sure compared to the equations programed in the AGC. 

Before beginning the derivation, a brief explanation and outline of 
the Kalman filter is given to aid in the understanding of this text. 
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The Kalman Filter 

The current position and velocity relative to a fixed reference 
system is computed onboard the spacecraft by integrating the vehicle's 
state vector and processing navigational observations. The Kalman filter 
statistically weights the observation and uses it to modify the state 
vector. 

The process used to correct the state at time t^ with the Kalman 
filter is as follows: x 

1. Make an observation y^ at t^. 

2. Integrate the state vector as stored in the vehicle computer to 

V 



3. Compute from this state vector the estimated observation 

Y l0 f°r V 

4. Find the residual y^ ~ Y^ 0 = Ay^. 

5. Compute the weighting factor K^ for the residual for t^. This 

factor is obtained by propagating the covariance matrix of state uncer- 
tainty to t^. 

6. Correct the state 



7. Also, correct, or update, P^ to pT . 

This process of statistically weighting single observations for vector 
correction works well. The number of observations required to reduce 
initial errors to the noise level and maintain this level of accuracy varies 
with mission phase and requirements. 
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total force on the CSM 
total force on the LM 

statistical weight placed on observational 
residual at t^ 

3 computed observation . t 
9 computed state i 

covariance matrix of the state vector uncertainty 
at time t^. 

relative position vector from the CSM to the D4 
computed relative position vector from the CSM to the LM 

relative velocity vector from the CSM to the LM 

computed relative velocity vector from the CSM to the IM 

relative acceleration vector from the CSM to the LM 

computed relative acceleration vector from the CSM to 
the LM 

range measurement at t^ 
computed range at t^ 

range-rate measurement at t^ 

computed range rate at t^ 

time, where i denotes any instant from the initial time 
to the final time 

uncertainties 

observation at t^ 

computed observation at t^ 

error transition matrix 

the superscript + indicates an update has occurred 
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APPLICATION OF THE KALMAN FILTER TO THE AGS 


Let us see how the AGS rendezvous’ radar filter equations follow 
from the Kalman equations. 


Linearity Assumption in the State and Error Transition Matrices 

The basic assumption made by the AGS filter is that the relative 
velocity between the CSM and LM is constant; i.e., 

; . - r . (1) 

1 o 

This implies 


r « 0 

F * F 
CSM IM 

Since the vehicles are coasting, the principal force on them is 
gravity. Thus, we assume that the two vehicles are along equipotential 
gravitational lines. 

The equation for integration of the state vector is 


r. ■ r + r At. 
loo 


( 2 ) 


Equations (l) and (2) are combined to get a state transition matrix 
repres ent at i on : 


ta ■ C ■:] CL 


where I and 0 are the 3*3 identity and zero matrices, respectively. 

The error transition matrix, fi, also follows from equations (l) and 

( 2 ). 


9 STATE i 
0 “ 9 STATE i _ 1 


o 
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So the error propagates as 

f: 

6r 


Ati) 1 6r| 

ij 163 


i-1 


Incorporation of Range Measurement 

Take a radar range measurement R^ at t^. To modify the state 
at t^ with this measurement, the full Kalman equation is 


where 


Cl -Cl • 


AR. 


K i " P i M i T (M i P i M i T + Cl2) ~ 1 * 

[a o -I 
rr rr j 

p i - 

o* o*» I 
L rr rr J . 


where 


and 


E[Ar, Ar] 9 


E[Ar, Ar] . E[Ar, Ar] 


P P 

1,1 1,2 

P P 

2,1 2,2 


( 3 ) 


vector 
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where 


p l,l 

■ a 

rr 

p 

* P 

1,2 

2,1 

P- o 

* a* . 

2,2 

rr 

M i“ 

[1 o] 


Before explaining these equations, ve should note that, except in 
the case of the state vector itself, all matrices have been reduced to 
scalar matrices to save storage space in the AGC. This reduction implies 
that the uncertainty in position and velocity is the same in each of 
their respective components. The covariance matrix, P, which is normally 
a 6 x 6, can be reduced to a 2 x 2. (ordinary algebraic operations; 
with scalar matrices are valid. Closure for addition and multiplication, 
as well as other properties, may be easily proved.) 

The covariance matrix, P, represents a numerical estimate of the 
uncertainties associated with the mathematical description space. These 
uncertainties include noises and biases on the state and prediction 
models and limitations of their representation for programing. 

The term a 2 represents the uncertainties of the observation space. 
Noises and biases of the observing instruments and the observer are 
included. 


Now 


M. 


3 computed observation (R^) 
3 computed state^ 


t 


i.e. , M gives a measure of the effect of a particular measurement on 
the state vector. For a range measurement, R^, 


M 


i 



* [l 0] . 


The position component is unity since the observation measures the 
relative range between the two vehicles. Recall that the state in the 
above equation is the relative state. 


To incorporate 1 ^, we first must find This requires P propa- 
gates as _ 


Pi - QPj.i O' 


f 1 4tI l pi.i Vlp °1 

L° J J L p i.a p a, J L 4 « *J 


or 


■ p l.l 


P l,l * 2P 1,2 “ + P 2,2 <“> 2 

P l,2 * P 2,2« 

*1,2 P 2,2. 

m 

P l,2 * P 2.2“ 

P 2,2 . 


How 


At " *i “ h-i 


i-1 


1,1 " P l,l + 2P l,2 At + P 2,2 (At)2 

(U) 

1,2 “ P l,2 + P 2,2 At 

( 5 ) 

2,2 " P 2,2 • 

(6) 


Comparing equations (U) , (5), and (6) to the following equations 
found in the ACC (ref. l). 


P l,l ■ P l,l ♦ 2 P l.s“ * p 2 ,2 ( “» 2 * «9 2 


P l,2 " P 1 ,2 •" P 2,2 4t 


(T) 


P 2.2 “ P 2,2 + ' 

it is seen that the constant K| has been added to keep the matrix 

positive definite during updating. The constant has been added to 

model the assumption that the variance in velocity increases with At. This 
ismeant to compensate for the basic assumption of linear motion, > 
equation (.1). 
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To get , 

K i “ P i M i T (M i P i M i T * ° 2) 



Again, comparing with the equations in the AGC, 



where 

o 2 - p u + R 2 + K| . 

So, the equations are identical if we set 

o 2 « K| R 2 + K*. 

3 3 

The constants K3 and Kf represent the noise on the range measurement . 
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If ^ were incorporated into the state at t^ the correction would 


he: 


Cl -Cl 


AR, 


where 


„ _ 11 » _ 12 

1 ” ^ ’ 2 " 2 * 

a 


® • r ic - E i 2 1 


where z ista unit vector along the computed line of sight as derived from 
angle data. 

Due to hardware limitations , however, the procedure does not occur 
until t^ + nfit, where 6t represents a computer cycle time and n is some 

positive integer. 

The updates at t^ would he 


- r i + "l 5r i 

(8) 

* r ± + w 2 toy 

(9) 


Propagating to t. + St (n ■ 1 for simplicity) according to (2) gives 


r i«t = r l * 5t • 


r i.st ■ r i * W 1 5r i + st ^i + m 2 5r i> 


r i + 6t *i + {W 1 + 6t V 6r i' 


From (8) and (9) 


it * w l.it 6r i > 


"l + st ■ M 1 * stv l 


The incorporation at t^ + 6t, is thus equivalent to (8), 


Since velocity is assumed linear. 


't * h * ¥ r i 

remains unchanged. 

Our range measurement has successfully altered the state vector 
according to equations (9) and (10). 

Finally P. must be updated before its propagation to the next ob 
servation. 


The Kalman update procedure is 

PT = [I - K^] P ± 

>:-lF 1-N 


[i 0] P, 
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P l,l P l,2 

i 

p i,i * p i,i w i 

P - P w 

*1,2 *1,2*1 

P l,2 P 2,2 

4 

_ P 1,2 - P 1,1 W 2 

P - p w 

*2,2 l,2 W 2J 


The P. 0 and P„ elements sure 

X % d dyX 


equivalent : 



So at t^. 


P l,l " ^l* 1 “ W l^ 


P l,2 * P l,2^ * V 


P s P - P W 

2,2 2,2 1,2 2 


which agree with the equations found in the AGS. We therefore conclude 
that the equations used to process rsuige in the AGC are theoretically 
sound. 


Incorporation of Range-Rate Measurement 

The rendezvous radar on the 124 can also measure range rate R. To 
modify the state vector with the measurement, the Kalman equation is: 
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f :■:! 


To find K we need M. Again recalling that we are measuring the 
relative state, 


Since 



= 1 . 


5 * : 



■Ti 

* .Vi 



"M 



Then, 


and 



M t = [0, 1] 


K i = P i M i T (M i P i M i T + ° 2) 
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0 

+ a 2 

P P 

1,2 2,2 


1 

/ 

P P 

1,2 2,2 

i 


. — 


_ 

\ 


- J 




4 



13 


To alter the state with R. 


*± - r i + ‘ ( |f J ' K ) 


( 12 ) 


and 


•+ • 2.2 .A 

r = r . + * AR, . 

1 1 1 


(13) 


Correction with (12) and (13) is possible. Present limitation of 
storage in AGC requires a simpler solution. Looking closer at (13), 
one can drop the noise, a 2 , so that 


•+ 

r i 



• + 

r i = 


r i + 


AR 


r 


This assumption of perfect R^ data is used onboard the IM in order 

to use the range-rate Doppler data. Equation (12) is not utilized; 
therefore, no position update occurs. 


CONCLUSIONS AND RECOMMENDATION 


We have shown that the AGS radar equations follow directly from 
Kalman theory after applying the assumption of linearity and perfect 
range-rate data, and after compensations for time-delayed incorporation 
of measurements. 

Having explored the theoretical grounds for the AGS and found them 
to be based soundly upon the given assumptions, one can suggest that the 
proper incorporation of range-rate data to update position and velocity 
could notably improve the accuracies obtained. This improvement used 
with proper adjustment of the compensating constants would increase the 
rendezvous capability of the AGS. 
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